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ABSTRACT 

A  two  state,  engine  speed  and  wheel  speed, 
powertrain  model  is  developed  with  bondgraph 
theory  and  coded  in  the  C  programming  language 
for  real-time  simulation  and  comparison  to  the 
same  model  implemented  in  the  MATLAB 
Simulink/Stateflow  environment.  Both  throttle 
and  braking  are  inputs  with  adjustable  engine, 
transmission,  and  vehicle  parameters.  The 
structure  of  the  model  implementation  provides 
for  decoupled  transmission  and  driveline  modules 
for  modularity.  Gear  shifting  is  accomplished 
with  a  shift  delay  of  0.8  seconds.  A  fixed  step 
Runge-Kutta  integration  scheme  is  used  with  a 
time  step  of  0.01  seconds.  Two  throttle  input 
cases  are  compared  for  each  model  with  the 
results  being  essentially  the  same  for  each  case  - 
peak  differences  are  attributed  to  signal  shift  on 
transition  edges.  Simulation  time  for  each  case 
was  200  seconds  and  was  achieved  within  5 
seconds  real-time.  This  is  a  40:1  simulation  time 
to  real-time  ratio. 


INTRODUCTION 

Advances  in  the  analytical  world  of  modeling  and 
simulation  can  be  attributed  to  not  only  faster 
microprocessors  and  computing  power  that  speed 
up  simulation  times,  but  new  formulations  of 
mathematical  models  that  in  and  of  themselves 
result  in  quicker  processing  speeds.  This 
capability  has  opened  up  the  possibility  for  new 
approaches  to  modeling  and  simulation  to  be 
explored.  One  of  these  is  real-time  simulation. 
No  longer  is  the  vehicle  manufacturer  limited  to 
evaluating  their  vehicle  on  the  computer  screen, 
but  can  experience  their  design  in  the  physical 
world  through  the  use  of  motion  simulators.  This 
"human-in-the-loop"  or  "hardware-in-the-loop" 
(HIL)  approach  requires  the  models  driving  the 


motion  simulators  to  perform  in  real-time  for  the 
most  accurate  and  realistic  representation  of  how 
the  vehicle  will  perform  once  manufactured. 

This  naturally  leads  to  the  definition  of  what 
really  does  "real-time"  mean.  In  general,  real¬ 
time  is  achieved  if  the  tasks  required  to  be 
performed  are  done  so  within  a  specified  amount 
of  time.  For  vehicle  dynamics  a  time  step  of 
around  1  millisecond  will  provide  most  of  the 
frequency  content  needed  for  a  representative 
model.  This  of  course  depends  upon  what 
specific  vehicle  attribute  is  being  looked  at  and 
might  require  more  refinement. 

This  report  addresses  the  need  for  a  real-time 
powertrain  model  to  be  used  with  any  vehicle 
model  on  a  motion  simulator.  In  particular,  it 
consists  of  an  engine,  automatic  transmission, 
and  driveline.  The  driveline  has  been  separated 
out  so  other  configurations  can  be 
accommodated.  The  torque  converter's 

operation  is  based  on  the  speed  ratio  between 
the  engine  and  driveline  at  the  converter  which 
provides  the  capacity  factor  (K)  and  torque  ratio 
of  the  transmission.  The  assumption  of  no 
compliance  in  the  driveline  and  no  losses  were 
made  to  compare  this  model  with  a  MATLAB 
Simulink/Stateflow  demonstration  model  of  an 
automatic  transmission  upon  which  it  is  based. 
Because  the  model  equations  were  converted  into 
a  bondgraph  the  compliances  and  losses  can 
easily  be  added  into  the  bondgraph  and  the 
model  equations  regenerated.  The  actual  real¬ 
time  powertrain  model  was  generated  based  on 
the  bondgraph  and  formulated  in  C  code. 
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MODEL  DESCRIPTION 

The  model  is  a  simplified  automatic  transmission 
consisting  of  an  engine,  torque  converter,  gear 
shift  mechanism,  transmission,  and  vehicle.  The 
vehicle  characteristics  are  lumped  together  to 
allow  implementation  of  the  powertrain  model 
without  focusing  on  the  details  of  the  vehicle 
dynamics.  Figure  1  shows  the  general  structure. 
This  is  taken  from  a  MATLAB  Simulink/Stateflow 
demonstration  so  that  the  resulting  bondgraph 
and  simulation  results  can  be  compared. 


Figure  1  -  MATLAB  Simulink/Stateflow  Diagram 


The  engine  receives  a  throttle  command  which  is 
its  input.  The  engine  torque  is  obtained  from  an 
engine  map  which  gives  an  engine  torque  for  a 
specific  throttle  setting  and  engine  speed.  (See 
Appendix  B  for  graphs  and  tables  of  these 
values.) 


IeiNe=Te-Ti 

I ei  =  engine  +  impeller  moment  of  inertia 
Ne  =  engine  speed 
Te  =  /  {throttle,  Ne)  =  engine  torque 
Tj  =  impeller  torque 


The  torque  characteristics  of  the  torque  converter 
are  determined  from  the  engine  speed  (impeller 
input)  and  turbine  (output)  speed.  A  lookup 
table  defines  the  capacity  factor  and  torque  ratio 
based  on  the  speed  ratio.  The  transmission  itself 
is  modeled  as  a  manual  transmission  with  small 
shift  times  to  emulate  the  automatic  shifting. 

Rtr  =  f  {gear)  =  transmission  ratio 

T  =  R  T 

1  out  tr 1  in 

Nin  =  RlrNout 

Tm ,  Toul  =  transmission  input  and  output  torque 

Nin ,  Nout  =  transmission  input  and  output  speed 


The  transmission  gear  ratio  depends  on  the  gear 
state.  The  current  model  uses  only  four  gears-- 
this  could  be  adjusted  easily.  The  output  of  the 
transmission  is  connected  through  a  final  drive  to 
a  simplified  "wheel"  system.  The  whole  vehicle 
inertia  is  accounted  for  in  one  wheel.  This  gives 
the  necessary  states  to  the  powertrain  model 
without  involving  the  details  of  various  drivelines 
(differentials,  all-wheel-drive,  six  wheel  and  eight 
wheel  configurations,  etc.). 


Iv  Nw  —  RfdT0Ut  Tload 

Iv  =  vehicle  inertia 
Nw  =  wheel  speed 
Rfd  ~  final  drive  ratio 
R load  =  fiNw)  =  load  torque 

The  load  torque  includes  all  the  running  gear 
forces  and  vehicle  resistances  as  well  as  the 
braking  torque. 


The  engine  is  connected  to  the  impeller  of  the 
torque  converter  which  provides  the  mechanism 
for  putting  torque  into  the  transmission. 


T  = 


N. 


impeller  torque 


\K  J 

K  -  f  (N in  /  N e )  =  capacity  or  K  -  factor 
Nin  =  turbine  speed  =  transmission  input  speed 
Tt  =  RtqTi  =  turbine  torque 
Rt  =  /  (Nin  /  Ne)  =  torque  ratio 


R load  =  sgn  (mph)(Rload0  +Rload2mph2  +Tbrake) 

Tioad  =  R>ad  torque 

R/oado  ~  friction  coefficient 

R  load  2  =  aerodynamicdrag  coefficient 

T brake  =  brake  torque 

mph  =  vehicle  linear  velocity 

This  completes  the  continuous  portion  of  the 
powertrain  model.  The  gear  shifting  composes 
the  discrete  part.  A  lookup  table  is  used  to 
determine  the  down  and  up  shift  speeds  based  on 
the  current  gear  and  throttle  input.  If  either  of 
these  conditions  are  met,  a  flag  is  set  to  indicate 
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entering  the  down  or  up  shift  mode  and  the 
current  time  is  recorded.  Once  in  this  mode,  if 
the  speed  (up  or  down  shift)  condition  is  not  met 
before  the  shift  delay  time  has  been  completed, 
the  flag  is  reset  and  steady  state  operation  is 
resumed.  Once  the  shift  delay  time  has  been 
satisfied  and  the  shift  (up  or  down)  flag  is  still 
set,  the  gear  state  is  changed  to  the  new  gear 
(up  or  down)  and  the  flag  reset.  The  MATLAB 
Stateflow  diagram  for  this  logic  is  included  in 
Appendix  A.  All  model  units  are  in  feet,  pounds 
force,  and  seconds. 


MODEL  IMPLEMENTATION 

Bondgraph  theory  was  used  to  develop  a  model 
of  the  powertrain  as  shown  in  Figure  2. 


^  Rtq=f(Nin/Ne)  Rtr=f(gear)  Rfd 


Te=f(throttle,Ne) 

Figure  2  -  Bondgraph  Model 

This  allows  efficient  development  of  the  state 
equations  for  implementing  the  model  with  a 
general  programming  language  in  an 
environment  that  will  run  real-time.  From  the 
bondgraph  in  Figure  2  the  equations  for  the 
powertrain  model  were  derived  (see  Appendix  C) 
and  were  coded  in  the  C  programming  language. 
The  C  language  offers  both  portability  and  speed. 
Implementation  in  other  programming  languages 
are  possible  as  well.  The  two  states  are  Ne 
(p2dot)  and  Nw  (p9dot) 

p2dot  =  e2  =  Te  -  Ti 
p9dot  =  e9  =  Rfd*Rtr*Rtq*Ti  -  Tload. 

A  modular  structure  was  preserved  to  allow  the 
engine/transmission  to  interface  with  different 
driveline  configurations.  The  current 

implementation  can  be  modified  as  desired.  To 
allow  this  modularity  to  work,  the  state  variables 
must  be  available  to  each  module  since  their 
functionality  is  dependent  upon  each.  The  two 
state  structures  shown  below  include  all 
necessary  variables  to  calculate  the  state. 

{ 

/*  engine  data  */ 

double  p2;  /*  engine  RPM  */ 

double  cet [RK_ORDER] ;  /*  engine  Torque  */ 

/*  torque  converter  data  */ 
double  sr [RK_ORDER] ;  /*  speed  ratio  */ 

double  ck [RK_ORDER] ;  /*  capacity  factor  */ 

double  crtq [RK_ORDER] ;  /*  torque  ratio  */ 


double  Ti [RK_ORDER] ;  /*  impeller  torque  */ 

/*  transmission  data  */ 

double  gearstate;  /*  gear  */ 

double  crtr;  /*  transmission  ratio  */ 

double  tdn;  /*  time  delay  for  downshift  */ 

double  tup;  /*  time  delay  for  upshift  */ 

int  flgd;  /*  flag  indicator  in  downshift  mode  */ 

int  flgu;  /*  flag  indicator  in  upshift  mode  */ 

/*  driver  inputs  */ 

double  cthrottle [RK_ORDER] ;  /*  throttle  input  */ 

/*  temp  variables  */ 
double  down_threshold; 
double  up_threshold; 

}  pwr_state; 

struct 

{ 

/*  vehicle  data  */ 

double  p9;  /*  wheel  RPM  */ 

double  Tload [RK_ORDER] ;  /*  Load  Torque  */ 

double  vspd [RK_ORDER] ;  /*  vehicle  speed  */ 

/*  driver  inputs  */ 

double  cbrake [RK_ORDER] ;  /*  brake  input  */ 

}  drvl_state; 

The  brake  input  is  included  in  the  driveline  state 
since  its  origination  is  from  the  wheel  spindle.  A 
fourth  order  fixed  step  Runge-Kutta  integration 
method  is  used  (h  =  0.01  sec).  This  choice 
reflects  the  desire  for  a  real-time  module  to 
complete  updating  the  state  variables  within  a 
specified  time  period.  The  fixed  step  attribute  of 
the  Runge-Kutta  method  satisfies  that  need, 
although  any  integration  method  that  meets  the 
real-time  requirements  can  be  used  instead. 

Seven  major  subroutines  make  up  the 
computational  structure  of  the  powertrain.  They 
are: 

void  init_pwr()  -  reads  in  data  and  initializes 
the  pwr  and  pwr  state  variables. 

void  init  drvio  -  reads  in  data  and  initializes 
the  drvl  and  drvi_state  variables. 

void  pwrmod  (double  t,  double  h)  -  formulates 
the  Runge-Kutta  integration  variables  and 
updates  the  states  for  pwr_state. 

void  update_pwr_state (double  t,int 
i,  double  rk)  -  update  the  intermediate  Runge- 
Kutta  integration  variables  for  each  t  and  h. 

void  drvlmod (double  t,  double  h)  - 

formulates  the  Runge-Kutta  integration  variables 
and  updates  the  states  for  drvl  state. 
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void  update_drvl__state  (double  t,int 
i,  double  rk)  -  update  the  intermediate  Runge- 
Kutta  integration  variables  for  each  t  and  h. 

void  shift  logic (double  t, double 

*up,  double  *dn)  -  determine  proper  gear  state 

to  enter  if  completed  down  or  up  shift  time  delay. 

Several  support  functions  are  necessary  for  the 
implementation  to  work.  These  are: 

int  interpl (double  *x,  double  *y,  int  1, 
double  xi,  double  *yo)  -  one  dimensional 
table  lookup  with  extrapolation. 

int  interp2 (double  *x,  double  *y,  double 
*z,  int  m,  int  n,  double  xi,  double  yi, 
double  *zo)  -  two  dimensional  table  lookup  with 
extrapolation  (uses  interpl). 

int  readtblld (const  char  *file,  int  *dim, 
double  arrld  [  ] )  -  read  in  values  for  a  one 
dimensional  table  from  an  input  file. 

int  readtbl2d (const  char  *file,  int  *dim, 
double  arr2d  [  ]  [dim [2]  ] )  -  read  in  values  for  a 
two  dimensional  table  from  an  input  file. 

int  printtblld ( int  *dim,  double  arrld[])  - 

print  values  for  a  one  dimensional  table. 

int  printtbl2d ( int  *dim,  double 
arr2d  [  ]  [dim [2]  ] )  -  print  values  for  a  two 
dimensional  table. 

It  should  be  noted  that  the  shift  delay  time  used 
was  0.8  seconds.  Adjustments  to  this  and  other 
parameters  must  be  made  to  match  the  specific 
engine/transmission  being  modeled.  The  source 
code  is  contained  in  Appendix  D. 


RESULTS 

Two  cases  were  considered  for  comparison.  Each 
contained  different  percentage  throttle  inputs  as 
shown  in  Table  1. 


Table  1  -  Percentage  Throttle  Input 


Case  1  |  Case  2 

Time 

Throttle  (%) 

0.0 

60.0 

20.0 

14.9 

40.0 

20.0 

15.0 

100.0 

20.0 

100.0 

0.0 

0.0 

200.0 

0.0 

0.0 

Appendix  E  contains  the  output  for  each  variable 
of  the  model.  The  outputs  between  the 
bondgraph  (C  coded)  and  MATLAB 
Simulink/Stateflow  were  essentially  identical.  For 
brevity  only  the  differences  in  engine  RPM  and 
vehicle  speed  are  presented  below. 


Case  1  Results: 


TIME  (S) 

Figure  3  -  Case  1  Engine  RPM  Model  Differences 


Figure  4  Case  1  Vehicle  Speed  Model  Differences 
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Case  2  Results: 
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Figure  5  -  Case  2  Engine  RPM  Model  Differences 
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Figure  6  -  Case  2  Vehicle  Speed  Model 

Differences 

The  peak  values  are  attributed  to  minor  shift 
differences  in  the  signal  transition  edges.  The 
shift  delay  time  can  have  an  effect  on  this  result. 
The  "chatter"  in  the  vehicle  speed  is  attributed  to 
small  integration  error  and  signal  offset  from  the 
integration  scheme  seeking  a  constant  speed 
value.  To  ensure  real-time  each  case  was 
simulated  for  200  seconds.  Table  2  gives  the 
results. 

Table  2  -  Simulation  Real-Time  in  seconds. 


Case  1 

Case  2 

4.24 

3.94 

times  reported,  but  not  more  than  approximately 
0.5  seconds.  For  a  worst  case  scenario  it  is 
assumed  that  the  simulation  time  is  5  seconds. 
It  should  also  be  noted  that  file  and  screen 
output  were  enabled  during  each  test,  thus 
consuming  more  time  than  necessary.  The  real¬ 
time  capability  reported  for  this  model  is 
therefore  on  the  conservative  side. 


CONCLUSION 

The  model  conforms  to  the  real-time  requirement 
by  a  ratio  of  40:1.  Modifications  to  the 
bondgraph  to  account  for  resistive  losses  and 
compliance  in  the  transmission  can  be  added  to 
provide  a  more  realistic  model.  An  addition  of  a 
fuel  map  would  allow  computation  of  vehicle  fuel 
economy  if  necessary.  More  complete  driveline 
modules  should  be  developed  to  provide  for 
specific  vehicle  configurations  (4x4,  6x6,  etc.) 
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MPH  -  Mile  per  hour 
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TARDEC  -  TACOM  Research,  Development  and 
Engineering  Center 
NAC  -  National  Automotive  Center 


This  gives  about  a  40:1  simulation  time  to  real¬ 
time  ratio.  It  should  be  noted  that  due  to 
processor  loads  there  was  some  fluctuation  in  the 
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APPENDIX  A  -  MATLAB  Simulink/Stateflow  Subsystem  Diagrams 
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APPENDIX  B  -  Graphs  &  Tables 
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APPENDIX  C  -  Bondgraph  Equations 

Step  1  -  Constitutive  Relationships 

el  =  Te  =  f(throttle,Ne) 
f2  =  p2/Ie 
e4  =  Ti  =  f(Ne,K) 
f9  =  p9/Iv 

elO  =  Hoad  =  f(vspd, brake) 


Step  2  -  Junction  Equations 


el  -  e2  -  e3  =  0  ->  e2  =  el  -  e3 

f2  =  f3  =  f5 

e3  =  e4  =  e5 

f5  =  Rtq  *f6 

f6  =  Rtr*f7 

17  =  Rfd*f8 

f8  =  f9 

e8  -  e9  -  elO  =  0  ->  e9  =  e8  -  elO 


Step  3  -  Substitutions 

throttle  =  input 
brake  =  input 
f2  =  Ne  =  p2/Ie 
f9  =  Nw  =  p9/Iv 

Te  =  interp2(nevec[],thvec[],emap[][],Ne,  throttle) 

Rtr  =  interpl(gear[],gearsratio[],gear) 

Nin  =  Rtr*Rfd*Nw 
sr=Nin/Ne 

K  =  interpl(sr[],K[],sr) 

Ti  =  (Ne/K)A2 
brake  =  input 

vspd  =  Nw*Rw*2*PI*60/5280  (RPM  ->  MPH) 

Tload  =  sign(vspd)*[RloadO+Rload2(vspd)A2  +  brake] 


e3  =  e4  =  Ti 


e5=e6/Rtq 

e6=e7/Rtr 

e7=e8/Rfd 

e8  =  Rfd*Rtr*Rtq*e5  =  Rfd*Rtr*Rtq*e4  =  Rfd*Rtr*Rtq*Ti 
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Step  4  -  State  Equations 


Q=  J fdt,e  =  KQ 
P  =  | edt,f  =  P  /  m 

Q  =  f 

P  =  e 

f2  =  p2/m 

p2dot  =  e2  =  Te-Ti 

p9dpt  =  e9  =  Rfd*Rtr*Rtq*Ti  -  Tload 
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APPENDIX  D  -  C  Program  Listings 


Complile  Commands 

cd  src/ 

cc  -c  interpl.c 
cc  -c  interp2.c 
cc  -c  readtblld.c 
cc  -c  printtblld.c 
cc  -c  readtbl2d.c 
cc  -c  printtbl2d.c 
cd  .  . 

cc  pwr-RT.c  -lm  src/interpl . o  src/interp2 . o  src/readtblld . o  src/printtblld . o  src/readtbl2d . o  src/printtbl2d . o 

Program  Listing 

/*  pwr-RT.c  */ 

#include  <stdio.h> 

#include  <math.h>  /*  atan,pow  */ 

#define  PI  4 . 0*atan (1 . 0 ) 

#def ine  MAX_CONVERTER_DATA_X  21  /*  SR,  K,  TR  */ 

#def ine  MAX_CONVERTER_DATA_Y  3 

#def ine  MAX_DOWNTAB_X  4 

#def ine  MAX_DOWNTAB_Y  6 

#def ine  MAX_DOWNTH  6 

#def ine  MAX_EMAP_X  11 

#def ine  MAX_EMAP_Y  10 

#def ine  MAX_NEVEC  11 

#def ine  MAX_THVEC  10 

#def ine  MAX_UPTAB_X  4 

#def ine  MAX_UPTAB_Y  6 

#def ine  MAXJJPTH  6 

#def ine  MAX_VEHICLEDATA  6 

#def ine  MAX_GEARS_X  4 

#def ine  MAX_GEARS_Y  2 

#def ine  MAX_THROTTLE_X  5 

#def ine  MAX_THROTTLE_Y  2 

#def ine  MAX_BRAKE_X  4 

#def ine  MAX_BRAKE_Y  2 

struct 

{ 

/*  engine  data  */ 

double  emap [MAX_EMAP_Y] [MAX_EMAP_X] ; 
double  nevec [MAX_NEVEC] ; 
double  thvec [MAX_THVEC] ; 

/*  torque  converter  data  */ 

double  converter^data [MAX_CONVERTER_DATA_Y] [ MAX_CONVERTER_DATA_X ] ; 

/*  transmission  data  */ 

double  gears [MAX_GEARS_Y] [MAX_GEARS_X] ; 

double  downtab [MAX_DOWNTAB_Y] [MAX_DOWNTAB_X] ; 

double  downth [MAX_DOWNTH] ; 

double  up tab [MAX_UPTAB_Y] [MAX_UPTAB_X] ; 

double  upth [MAXJJPTH] ; 

double  tw;  /*  shift  time  */ 

/*  driver  inputs  */ 

double  throttle [MAX_THROTTLE_Y] [MAX_THROTTLE_X] ; 

}  pwr;  /*  values  in  ft, lbs, sec  */ 

struct 

{ 

/*  vehicle  data  */ 

double  vehicledata [MAX_VEHICLEDATA] ; 
double  ie;  /*  engine  inertia  */ 
double  rfd;  /*  final  drive  ratio  */ 
double  rloadO;  /*  rolling  resistance  */ 
double  rload2;  /*  air  drag  coefficient  */ 
double  rw;  /*  wheel  radius  */ 
double  iv;  /*  vehicle  inertia  */ 
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/*  driver  inputs  */ 

double  brake [MAX_BRAKE_Y] [MAX_BRAKE_X] ; 

}  drvl;  /*  values  in  ft, lbs, sec  */ 

#def ine  RK_ORDER  4 

struct 

{ 

/*  engine  data  */ 

double  p2;  /*  engine  RPM  */ 

double  cet [RK_ORDER] ;  /*  engine  Torque  */ 

/*  torque  converter  data  */ 
double  sr [RK_ORDER] ;  /*  speed  ratio  */ 

double  ck [RK_ORDER] ;  /*  capacity  factor  */ 

double  crtq [RK_ORDER] ;  /*  torque  ratio  */ 

double  Ti [RK_ORDER] ;  /*  impeller  torque  */ 

/*  transmission  data  */ 

double  gearstate;  /*  gear  */ 

double  crtr;  /*  transmission  ratio  */ 

double  tdn;  /*  time  delay  for  downshift  */ 

double  tup;  /*  time  delay  for  upshift  */ 

int  flgd;  /*  flag  indicator  in  downshift  mode  */ 

int  flgu;  /*  flag  indicator  in  upshift  mode  */ 

/*  driver  inputs  */ 

double  cthrottle [RK_ORDER] ;  /*  throttle  input  */ 

/*  temp  variables  */ 
double  down_threshold; 
double  up_threshold; 

}  pwr_state; 

struct 

{ 

/*  vehicle  data  */ 

double  p9;  /*  wheel  RPM  */ 

double  Tload [RK_ORDER] ;  /*  Load  Torque  */ 

double  vspd [RK_ORDER] ;  /*  vehicle  speed  */ 

/*  driver  inputs  */ 

double  cbrake [RK_ORDER] ;  /*  brake  input  */ 

}  drvl_state; 

void  update_pwr_state (double  t,int  i, double  rk) ; 

void  update_drvl_state (double  t,int  i, double  rk) ; 

void  shift_logic (double  t, double  *up, double  *dn) ; 

void  init_pwr ( ) ; 

void  init_drvl () ; 

void  drvlmod (double  t,  double  h) ; 

void  pwrmod (double  t,  double  h) ; 

/* - PROGRAM  START - */ 

void  main ( ) 

{ 

/*  - VARIABLES 

fidl,fid2  file  handles  for  misc.  output 
h  time  step  increment 

t  time 

end  end  time 

ierr  function  return  code 

*/ 

FILE  *f idl , *f id2 ; 
double  h,t,end; 
int  ierr; 

init_drvl();  /*  make  sure  to  do  this  f irst--init_pwr  uses  drvl . ie  for  initial  p2* / 
init_pwr ( ) ; 

fidl  =  fopen ( "outl . txt" , "wt" ) ; 
fid2  =  fopen ( "out2 . txt" , "wt" ) ; 
h  =  0.01;  /*  set  time  step  */ 
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end  =  200.0;  /*  end  after  200  seconds  */ 


/* - MAIN  LOOP - */ 

t  =  0.0; 

for  (t  =  0.0;  t  <=  200.0;  t  =  t  +  h) 

i 

pwrmod (t, h) ; 

drvlmod (t, h) ; 

shift_logic (t, &pwr_state .up_threshold, &pwr_state . down_threshold) ; 

fprintf (fidl, "%lf  %lf  %lf  %lf  %lf  %lf  %lf  %lf  %lf  %lf  %lf  %lf  %lf  %lf  %lf\n", 

t,pwr_state .p2/drvl . ie,  drvl_state . vspd [0 ] , pwr_state . cthrottle [0 ] , drvl_state . cbrake [0 ] , 
pwr_state . cet [0 ] , pwr_state . crtr , pwr_state . sr [0 ] , pwr_state . ck [0 ] , pwr_state . crtq [0 ] , pwr_state . Ti [0 ] , 
drvl_state . Tload [0 ] , pwr_state . gear state, pwr_state . up_threshold, pwr_state . down_threshold) ; 

printf ( "gear, th, up, sp, dn=%lf  %lf  %lf  %lf  %lf\n" , pwr_state . gearstate, pwr_state . cthrottle [ 0 ] , 
pwr_state .up_threshold, drvl_state .vspd [0 ] , pwr_state . down_threshold)  ; 

} 

fclose (fidl) ; 

fclose (fid2) ; 


void  init_pwr() 

{ 

/*  - INITIALIZE  THE  PWR  AND  PWR_STATE  STRUCTURE  DATA  -  UNITS  ARE  FT, LBS, SEC, RPM -  */ 

int  dim[3];  /*  dim[0]  =  #  of  dimensions,  dim[l]  =  size  of  diml,  dim[2]  =  size  of  dim2  */ 

int  ierr;  /*  error  return  code  */ 

dim [ 0 ]  =  2; 

dim  [  1  ]  =  MAX_EMAP_Y; 

dim [2]  =  MAX_EMAP_X; 

ierr  =  readtbl2d ( "emap . arr" , dim, pwr . emap)  ; 

/*  ierr  =  printtbl2d (dim, pwr . emap) ;  */ 

dim [ 0 ]  =  1; 

dim  [  1  ]  =  MAX_NEVEC; 

dim [2]  =  0; 

ierr  =  readtblld ( "nevec . arr ",  dim, pwr . nevec) ; 

/*  ierr  =  printtblld (dim, pwr . nevec) ;  */ 

dim [ 0 ]  =  1; 

dim  [  1  ]  =  MAX_THVEC; 

dim [2]  =  0; 

ierr  =  readtblld ( "thvec . arr ",  dim, pwr . thvec) ; 

/*  ierr  =  printtblld (dim, pwr . thvec) ;  */ 

dim [ 0 ]  =  2; 

dim [ 1 ]  =  MAX_CONVERTER_DATA_Y ; 
dim [2]  =  MAX_CONVERTER_DATA_X; 

ierr  =  readtbl2d ( "converter_data . arr" , dim, pwr . converter_data) ; 

/*  ierr  =  printtbl2d (dim, pwr . converter_data) ;  */ 

dim [ 0 ]  =  2; 

dim  [  1  ]  =  MAX_GEARS_Y; 

dim [2]  =  MAX_GEARS_X; 

ierr  =  readtbl2d ( "gears . arr" , dim, pwr . gears) ; 

/*  ierr  =  printtbl2d (dim, pwr . gears) ;  */ 

dim [ 0 ]  =  2; 

dim  [  1  ]  =  MAX_DOWNTAB_Y ; 
dim [2]  =  MAX_DOWNTAB_X; 

ierr  =  readtbl2d ( "downtab . arr" , dim, pwr . downtab) ; 

/*  ierr  =  printtbl2d (dim, pwr . downtab) ;  */ 

dim [ 0 ]  =  1; 

dim [ 1 ]  =  MAXJDOWNTH; 

dim [2]  =  0; 

ierr  =  readtblld ( "downth . arr ",  dim, pwr . downth) ; 

/*  ierr  =  printtblld (dim, pwr . downth) ;  */ 

dim [ 0 ]  =  2; 

dim  [  1  ]  =  MAX_UPTAB_Y; 

dim [2]  =  MAX_UPTAB_X; 

ierr  =  readtbl2d ( "uptab . arr " , dim, pwr . uptab) ; 

/*  ierr  =  printtbl2d (dim, pwr . uptab) ;  */ 

dim [ 0 ]  =  1; 

dim [ 1 ]  =  MAXJJPTH; 

dim [2]  =  0; 

ierr  =  readtblld ( "upth . arr ",  dim, pwr . upth) ; 

/*  ierr  =  printtblld (dim, pwr . upth) ;  */ 

dim [ 0 ]  =  2; 

dim [ 1 ]  =  MAX_THROTTLE_Y; 
dim [2]  =  MAX_THROTTLE_X; 

ierr  =  readtbl2d ( "throttle . arr ",  dim, pwr . throttle) ; 

/*  ierr  =  printtbl2d (dim, pwr . throttle) ;  */ 

pwr_state . gearstate  =1.0;  /*  start  in  1st  gear  */ 

ierr  =  interpl ( &pwr . gears [ 0 ] [0 ], &pwr . gears [1 ] [ 0 ], MAX_GEARS_X, pwr_state . gearstate, &pwr_state . crtr) ; 
transmission  ratio  */ 

pwr.tw  =0.08;  /*  set  the  shift  time  delay  */ 

pwr_state . tdn  =0.0;  /*  initialize  down  shift  time  to  zero  */ 

pwr_state . tup  =0.0;  /*  initialize  up  shift  time  to  zero  */ 

pwr_state . f lgd  =0;  /*  initialize  downshift  state  flag  to  zero  */ 
pwr_state . f lgu  =0;  /*  initialize  upshift  state  flag  to  zero  */ 


/*  set 


pwr_state.p2  =  1000.0  *  drvl.ie;  /*  initial  engine  speed  to  1000  RPM  */ 


20 


///*  temp  vars  */ 

//pwr_state . down_threshold=0 . 0 ; 
//pwr_state . up_threshold=0 . 0 ; 
/*pwr_state . aa [RK_ORDER] =0 . 0 ;  * 


void  init_drvl() 

{ 

/*  - INITIALIZE  THE  DRVL  AND  DRVL_STATE  STRUCTURE  DATA  -  UNITS  ARE  FT, LBS, SEC, RPM -  */ 

int  dim[3];  /*  dim[0]  =  #  of  dimensions,  dim[l]  =  size  of  diml,  dim[2]  =  size  of  dim2  */ 

int  ierr;  /*  error  return  code  */ 

dim [0 ]  =  1; 

dim [ 1 ]  =  MAX_VE H I C LE  DATA ; 
dim [2]  =  0; 

ierr  =  readtblld ( "vehicledata . arr" , dim, drvl . vehicledata) ; 

/*  ierr  =  printtblld (dim, drvl . vehicledata) ;  */ 

dim [ 0 ]  =  2; 

dim [ 1 ]  =  MAX_BRAKE_Y ; 

dim [2]  =  MAX_BRAKE_X ; 

ierr  =  readtbl2d ( "brake . arr" , dim, drvl .brake) ; 

/*  ierr  =  printtbl2d (dim, drvl .brake) ;  */ 

drvl.ie  =  drvl . vehicledata [ 0 ] ;  /*  engine  speed  RPM  */ 

drvl.rfd  =  drvl . vehicledata [ 1 ] ;  /*  final  drive  ratio  */ 

drvl . rloadO  =  drvl . vehicledata [2 ] ;  /*  road  load  -  resistance  */ 

drvl . rload2  =  drvl .vehicledata [3] ;  /*  road  load  -  aerodynamic  drag  */ 

drvl . rw  =  drvl .vehicledata [4] ;  /*  tire  radius  */ 

drvl . iv  =  drvl .vehicledata [5] ;  /*  vehicle  inertia  */ 

drvl_state . p9  =  0.0;  /*  initialize  wheel  speed  to  zero  */ 
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void  update_pwr_state (double  t,int  i, double  rk) 

{ 

/*  - UPDATE  THE  PWR_STATE  STRUCTURE  DATA -  */ 

int  ierr;  /*  error  return  code  */ 

/*  - UPDATE  THROTTLE,  ENGINE  TRQ,  SPEED  RATIO,  K-FACTOR,  TRQ  RATIO,  IMPELLER  TRQ -  */ 

ierr  =  interpl ( &pwr . throttle [ 0 ] [0 ], Spwr . throttle [1 ] [ 0 ] , MAX_THROTTLE_X , t , &pwr_state . cthrottle [i ] ) ; 
ierr  =  interp2 (pwr . nevec, pwr . thvec, pwr . emap, MAX_NEVEC, MAX_THVEC, (pwr_state .p2+rk) /drvl . ie, 
pwr_state . cthrottle [ i ] , &pwr_state . cet [ i ] )  ; 

pwr_state . sr [ i ]  =  (pwr_state . crtr*drvl_state . p9*drvl . rf d/drvl . iv) / ( (pwr_state . p2+rk) /drvl . ie)  ; 
ierr  =  interpl ( Spwr . converter_data [ 0 ] [ 0 ] , &pwr . converter_data [ 1 ] [ 0 ] , MAX_CONVERTER_DATA_X, pwr_state . sr [i ] , 
&pwr_state . ck [i]  ); 

ierr  =  interpl ( &pwr . converter_data [ 0 ] [ 0 ] , Spwr . converter_data [2 ] [ 0 ] , MAX_CONVERTER_DATA_X, pwr_state . sr [i ] , 
&pwr_state . crtq [i]  ); 

pwr_state . Ti [i]  =  pow (  ( (pwr_state . p2+rk) /drvl . ie) /pwr_state . ck [i ] 


,2.0); 


void  update_drvl_state (double  t,int  i, double  rk) 

{ 

/* - UPDATE  THE  DRVL_STATE  STRUCTURE  DATA - */ 

double  vs;  /*  sign  of  vehicle  speed  */ 
int  ierr;  /*  error  return  code  */ 

/*  - UPDATE  BRAKE  FORC,  VEHICLE  SPEED,  LOAD  TRQ -  */ 

ierr  =  interpl ( &drvl . brake [ 0 ] [ 0 ], &drvl . brake [ 1 ] [0 ], MAX_BRAKE_X, t, &drvl_state , cbrake [i] ) ; 
drvl_state .vspd [i]  =  2 . 0*PI*drvl . rw* ( 60 . 0/5280 . 0 )* (drvl_state .p9+rk) /drvl . iv;  /*  RPM  -  >  MPH  */ 

if  (drvl_state . vspd [i]  >=  0.0) 

{ 

vs  =  1.0; 

} 

else 

{ 

vs  =  -1.0; 

} 

drvl_state . Tload [ i ]  =  vs* (drvl . rloadO+drvl . rload2*pow (drvl_state . vspd [i] , 2 . 0 ) +drvl_state . cbrake [i ] ) 


void  shift_logic (double  t, double  *up, double  *dn) 

{ 

/* - DETERMINE  SHIFT  STATE - */ 

int  ierr;  /*  error  return  code  */ 

/*  - SET  SHIFT  UP  AND  SHIFT  DOWN  SPEEDS -  */ 

ierr  =  interp2 ( &pwr . gears [ 0 ] [ 0 ] , pwr . downth, pwr . downtab, MAX_GEARS_X, MAX_DOWNTH, pwr_state . gear state, 
pwr_state . cthrottle [0]  ,  dn)  ; 

ierr  =  interp2 ( &pwr . gears [ 0 ] [ 0 ], pwr . upth, pwr . uptab, MAX_GEARS_X, MAX_UPTH, pwr_state . gearstate, 
pwr_state . cthrottle [0] , up)  ; 

if  ( (pwr_state . f lgd  !=  1)  &&  (drvl_state . vspd [0 ] <*dn) ) 

( 

/* - ENTER  DOWN  SHIFT  MODE - */ 

pwr_state . tdn  =  t;  /*  current  time  */ 
pwr_state . f lgd  =1;  /*  flag  */ 

} 

if  ( (pwr_state . f lgd  ==  1)  &&  (drvl_state . vspd [0 ] >*dn) )  pwr_state . flgd=0;  /*  exit  down  shift  */ 

if  ( (pwr_state . f lgd  ==  1)  &&  (t-pwr_state . tdn  >=  pwr.tw)  &  (drvl_state . vspd [ 0 ] <=*dn) )  /*  shift  down  after  tw 
seconds  */ 

{ 

/* - SHIFT  DOWN - */ 

if  (pwr_state . gearstate==4 . 0 )  pwr_state . gearstate  =  pwr_state . gearstate-1 . 0; 
else  if  (pwr_state . gearstate==3 . 0 )  pwr_state . gearstate  =  pwr_state . gearstate-1 . 0; 
else  if  (pwr_state . gearstate==2 . 0 )  pwr_state . gearstate  =  pwr_state . gearstate-1 . 0; 

} 

if  ( (pwr_state . f lgu  !=  1)  &&  (drvl_state . vspd [0 ] >*up) ) 

{ 

/*  - ENTER  UP  SHIFT  MODE -  */ 

pwr_state . tup  =  t;  /*  current  time  */ 
pwr_state . f lgu  =1;  /*  flag  */ 

} 

if  ( (pwr_state . f lgu  ==  1)  &&  (drvl_state . vspd [0 ] <*up) )  pwr_state . flgu  =  0;  /*  exit  up  shift  */ 
if  ( (pwr_state . f lgu==l )  &&  (t-pwr_state . tup  >=  pwr.tw)  &&  (drvl_state . vspd [0] >=*up) )  /*  shift  up  after  tw 

seconds  */ 

{ 

/* - SHIFT  UP - */ 

if  (pwr_state . gearstate==3 . 0 )  pwr_state . gearstate  =  pwr_state . gearstate+1 . 0; 
else  if  (pwr_state . gearstate==2 . 0 )  pwr_state . gearstate  =  pwr_state . gearstate+1 . 0; 
else  if  (pwr_state . gearstate==l . 0 )  pwr_state . gearstate  =  pwr_state . gearstate+1 . 0; 

} 
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void  pwrmod (double  t,  double  h) 

{ 

/*  - UPDATE  PWR  STATE  VARIABLE  P2-  ENGINE  RPM -  */ 

double  p2h;  /*  temporary  state  variable  */ 

double  aa [RK_ORDER] ;  /*  Runge-Kutta (RK)  Integration  variable  */ 

int  ierr;  /*  error  return  code  */ 

ierr  =  interpl ( &pwr . gears [ 0 ] [ 0 ], &pwr . gears [ 1 ] [ 0 ] , MAX_GEARS_X, pwr_state . gearstate, &pwr_state . crtr ) ; 
the  transmission  ratio  */ 

/*  - UPDATE  PWR  STATE  VARIABLE  P2  FOR  EACH  STEP  -  4TH  ORDER  RK -  */ 

update_pwr_state (t, 0, 0 . 0) ; 

aa[0]  =  h* (pwr_state . cet [0] -pwr_state . Ti [0] )  ; 

update_pwr_state (t+h/2 . 0, 1 , aa [0 ] /2 . 0 )  ; 
aa[l]  =  h* (pwr_state . cet [1 ] -pwr_state . Ti [1 ] )  ; 

update_pwr_state (t+h/2 . 0, 2 ,  aa [1 ] /2 . 0 )  ; 
aa[2]  =  h* (pwr_state . cet [2 ] -pwr_state . Ti [2 ]  )  ; 

update_pwr_state (t+h,  3,  aa [2 ]  )  ; 

aa[3]  =  h* (pwr_state . cet [3] -pwr_state . Ti [3] ) ; 

p2h  =  pwr_state .p2+ (aa [0 ] +2 . 0*aa [1 ] +2 . 0*aa [2 ] +aa [3] ) /6 . 0 ; 

/*  - ENSURE  PWR  STATE  VARIABLE  P2  IS  IN  PROPER  RANGE -  */ 

if  (p2h/drvl . ie  >  6000.0) 

{ 

p2h  =  6000.0  *  drvl.ie;  /*  upper  limit  =  6000  RPM  */ 

} 

else  if  (p2h/drvl.ie  <  600.0) 

{ 

p2h  =  600.0  *  drvl.ie;  /*  lower  limit  =  600  RPM  */ 

} 

/* - UPDATE  STATE - */ 

pwr_state .p2=p2h; 


} 


/*  update 
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void  drvlmod (double  t, double  h) 

{ 

/* - UPDATE  DRVL  STATE  VARIABLE  P8 -WHEEL  RPM - */ 

double  p9h;  /*  temporary  state  variable  */ 

double  aa [RK_ORDER] ;  /*  Runge-Kutta (RK)  Integration  variable  */ 

int  ierr;  /*  error  return  code  */ 


/*  - UPDATE  DRVL  STATE  VARIABLE  P8  FOR  EACH  STEP  -  4TH  ORDER  RK -  */ 

/*  if  internal  states  not  available  or  unknown  use  stage [0]  to  simulate  only  one  or  previous  state  */ 
update_drvl_state (t, 0,0.0) ; 

aa[0]  =  h* (drvl . rfd*pwr_state . crtr*pwr_state . crtq [0 ] *pwr_state . Ti [0 ]  -  drvl_state . Tload [ 0 ] ) ; 
update_drvl_state (t+h/2 . 0, 1,  aa [0 ] /2 . 0 )  ; 

aa[l]  =  h* (drvl . rfd*pwr_state . crtr*pwr_state . crtq [ 1 ] *pwr_state .Ti [1 ]  -  drvl_state . Tload [ 1 ]) ; 
update_drvl_state (t+h/2 . 0 , 2, aa [1 ] /2 . 0 )  ; 

aa[2]  =  h* (drvl . rfd*pwr_state . crtr*pwr_state . crtq [2 ] *pwr_state .Ti [2 ]  -  drvl_state . Tload [2 ] ) ; 


update_drvl_state (t+h,  3,  aa [2  ]  )  ; 

aa[3]  =  h* (drvl . rfd*pwr_state . crtr*pwr_state . crtq [3] *pwr_state .Ti [3]  -  drvl_state . Tload [3] ) ; 


p9h  =  drvl_state .p9+ (aa [0 ] +2 . 0*aa [1 ] +2 . 0*aa [2 ] +aa [3] ) /6 . 0 ; 


/* - UPDATE  STATE - */ 

drvl_state .p9  =  p9h; 
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Support  Functions 


/*  interpl.c 

This  is  a  ID  interpolation  subroutine.  Given  x,y  and  xi  return 
interplated  value  yo.  Return  function  value  is  index  s  or  -s  if 
out  of  range.  If  out  of  range,  yo  is  extrapolated. 


*/ 


02-03-27  Updated  syntax. 

02-03-11  Converted  to  C  from  F90.  Indexes  in  C  are  zero 
Adjust  s,  e,  pvt's  accordingly. 


[0] "  based. 


#include  <stdio.h> 


int  interpl (double  *x,  double  *y,  int  1,  double  xi,  double  *yo) 

{ 

/* - VARIABLES - */ 

int  s;  /*  start  index  */ 

int  e;  /*  end  index  */ 

int  pvtl;  /*  pivot  pt  1  */ 

int  pvt2;  /*  pivot  pt  2  for  even  */ 

int  i;  /*  process  counter  */ 

s  =  0;  /*  start  at  very  beginning  */ 

e  =  1  -  1;  /*  start  at  very  end  */ 

/*  check  for  range  error  */ 
if  (xi  <  *  (x)  ) 

{ 

/*  if  no  extrapolation  use  ->  *yo  =  * (y) ;  */ 

/*  extrapolate  */ 
s  =  0  ; 
e  =  s  +  1  ; 

*yo  =  *  (y  +  s)  +  (xi  -  *  (x  +  s)  )  *  (  *  (y  +  e)  -  *(y  +  s)  )  /  (  *  (x  +  e)  -  *  (x  +  s)  ); 

return  -s;  /*  (-)  means  out  of  range  */ 

} 

else  if  (  xi  >  *  (x  +  1  -  1 ) ) 

{ 

/*  if  no  extrapolation  use  ->  *yo  =  * (y  +  1  -  1);  */ 

/*  extrapolate  */ 
e  =  1  -  1  ; 
s  =  e  -  1  ; 

*yo  =  *  (y  +  s)  +  (xi  -  *  (x  +  s)  )  *  (  *  (y  +  e)  -  *(y  +  s)  )  /  (  *  (x  +  e)  -  *  (x  +  s)  ); 

return  -s;  /*  (-)  means  out  of  range  */ 

} 

/* - PROCESS  LOOP - */ 

for  (i  =  0;  i  <  1;  i++) 

( 

if  ( (e  -  s)  %  2  ==  0  ) 

{ 

/* - EVEN - */ 

pvtl  =s+  (e-s)  /  2; 
if  (xi  ==  * (x  +  pvtl)) 

{ 

*yo  =  * (y  +  pvtl ) ; 
return  pvtl; 

} 

if  (xi  >  * (x  +  pvtl)) 

{ 

s  =  pvtl;  /*  top  half  */ 

} 

else 

{ 

e  =  pvtl;  /*  bottom  half  */ 

} 

} 

else 

{ 

/* - ODD - */ 

pvtl  =s+  (e-s-1)  /  2; 
pvt2  =  pvtl  +  1; 
if  (xi  >  * (x  +  pvt2) ) 

{ 

s  =  pvt2;  /*  top  half  */ 

} 
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else  if  (xi  <  * (x  +  pvtl)) 

{ 

e  =  pvtl;  /*  bottom  half  */ 

} 

else 

{ 

s  =  pvtl;  /*  between  these  */ 
e  =  pvt2 ; 

} 

} 

if  <(e  -  s)  <=  1) 

{ 

/* - FINAL  ANSWER - */ 

*yo  =  *  (y  +  s)  +  (xi  -  *  (x  +  s)  )  *  (  *(y  +  e)  -  *(y  +  s)  )  /  (  *  (x  +  e)  -  *  (x  +  s)  ); 
return  s; 

} 

} 

return  -1; 

} 
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/*  interp2.c 

This  is  a  2D  interpolation  subroutine.  Given  x,y,z,xi  and  yi  return 
interplated  value  zo.  Return  function  value  is  -s  if 
out  of  range.  Uses  interpl 

02-03-27  Updated  syntax. 

02-03-11  Converted  to  C  from  F90.  Indexes  in  C  are  zero  "[0]"  based. 


#include  <stdio.h> 

/*int  interpl (double  *x,  double  *y,  int  1,  double  xi,  double  *yo)*/ 

int  interp2 (double  *x,  double  *y,  double  *z,  int  m,  int  n,  double  xi,  double  yi,  double  *zo) 

{ 

/* - VARIABLES - */ 

int  sx;  /*  start  x  index  */ 
int  sy;  /*  start  y  index  */ 

//  int  i;  /* 

int  ierr;  /*  error  return  code  */ 
double  valy;  /*  interpolated  value  of  yl  */ 
double  valyl;  /*  interpolated  value  of  y2  */ 
double  tmp;  /*  temporary  variable  */ 

/* - GET  INDEXES - */ 

sx  =  interpl (x, x, m, xi, &tmp) ; 
sy  =  interpl (y, y, n, yi, &tmp) ; 

/*  - IF  YOU  DO  NOT  WANT  EXTRAPOLATION  UNCOMMENT  THIS  CODE - 

%  if  (sx==-l  | |  sy==-l) 

%  ( 

%  * (zo)  =  -1; 

%  return  -1; 

%  } 

*/ 

/*  - GET  Y'S  FROM  X'S -  */ 

valy  =  *(z  +  sy*m  +  sx)  +  (xi  -  * (x  +  sx) )  *  (  *(z  +  sy*m  +  (sx+1) )  -  *(z  +  sy*m  +  sx)  )  /  (  * (x  + 
*  (x  +  sx)  )  ; 

valyl  =  *(z  +  (sy+l)*m  +  sx)  +  (xi  -  *  (x  +  sx)  )  *  (  *(z  +  (sy+l)*m  +  (sx+1))  -  *(z  +  (sy+l)*m  +  sx) 
+  (sx+1))  -  * (x  +  sx)  ); 

/* - GET  Z  FROM  Y'S - */ 

*zo  =  valy  +  (yi  -  * (y  +  sy) )  *  (valyl  -  valy)  /  (  * (y  +  (sy+1) )  -  * (y  +  sy)  ); 
return  0; 


(sx+1))  - 
)  /  (  *(x 
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/*  readtblld.c 

Reads  in  table  from  file  according  to  format. 

02-03-27  Update  syntax. 

02-03-18  Created. 

- INPUT  FILE  FORMAT - 

%%NDIM:#  dimenstions 
%%DIMS:diml  dim2  dim3  dim4  ... 
val  ( ) 

%comment 
val  ( ) 


#include  <string.h>  /*strncmp*/ 

#include  <stdio.h> 

int  readtblld (const  char  *file,  int  *dim,  double  arrld[]) 

{ 

/* - VARIABLES - */ 

FILE  *fin;  /*  file  handle  */ 
int  val;  /*  scanned  value  */ 
int  ndim;  /*  number  of  dimensions  */ 
int  dims [2];  /*  size  of  dimensions  */ 

char  buff [1024];  /*  read  buffer  */ 

int  row;  /*  row  counter  */ 

fin  =  fopen (file, "r") ; 
if  (fin  ==  NULL) 

{ 

fclose (fin) ; 
return  -1; 

} 

/* - PROCESS  HEADER - */ 

ndim  =  dims[0]  =  dims[l]  =  row  =  0; 
while  (fgets (buff , 1024, fin)  !=  NULL) 

{ 

if  (strncmp (buff 2) ==0) 

{ 

if  ( strncmp ( &buf f [2 ] , "NDIM: " , 5) ==0 ) 

{ 

val  =  sscanf ( &buf f [ 7 ] , "%d\n" , &ndim) ; 

} 

else  if  (strncmp (Sbuff [2] , "DIMS 5) ==0) 

{ 

if  (ndim  ==  1) 

{ 

val  =  sscanf (sbuff [7] , "%d\n", &dims [0] ) ; 

} 

} 

} 

else  if (strncmp (buff, "%", 1) ! =0 ) 

{ 

break; 

} 

} 

val  =  sscanf ( sbuff [0 ], "%lf\n" , Sarrld [row] ) ; 
row++; 

if  ((ndim  !=  dim[0])  I  I  (dims[0]  !=  dim[l]))  return  -1; 

/* - PROCESS  DATA - */ 

while  (fgets (buff , 1024, fin)  !=  NULL) 

{ 

if  ( strncmp (buff 1 ) ==0 )  continue; 

val  =  sscanf ( &buff [0 ], "%lf\n" , &arrld [row] ) ; 

row++; 

if  (row  >=  dim[l])  break; 

/*  check  row  bound  here  */ 

} 

fclose (fin) ; 
return  0; 
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/*  readtbl2d.c 

Reads  in  2d  table  from  file  according  to  format. 

02-03-27  Update  syntax. 

02-03-18  Created. 

- INPUT  FILE  FORMAT - 

%%NDIM:#  dimenstions 
%%DIMS:diml  dim2  dim3  dim4  ... 
val  ( ) 

%comment 
val  ( ) 


#include  <string.h>  /*strncmp*/ 

#include  <stdio.h> 

int  readtbl2d (const  char  *file,  int  *dim,  double  arr2d[] [dim[2]]) 

{ 

/* - VARIABLES - */ 

FILE  *fin;  /*  file  handle  */ 

int  val;  /*  scanned  value  */ 

int  ndim;  /*  number  of  dimensions  */ 

int  dims [2];  /*  size  of  dimensions  read  in  */ 

char  buff [1024];  /*  read  buffer  */ 

int  row;  /*  row  counter  */ 

int  col;  /*  col  counter  */ 

double  dtmp;  /*  temporary  double  */ 

fin  =  fopen (file, "r") ; 

if  (fin  ==  NULL) 

{ 

fclose (fin) ; 
return  -1; 

} 

/* - PROCESS  HEADER - */ 

ndim  =  dims[0]  =  dims[l]  =  row  =  col  =  0; 
while  (fgets (buff , 1024, fin)  !=  NULL) 

{ 

if  (strncmp (buff 2) ==0) 

{ 

if  ( strncmp ( &buf f [2 ] , "NDIM: " , 5) ==0 ) 

{ 

val  =  sscanf ( &buf f [ 7 ] , "%d\n" , Sndim) ; 

} 

else  if  (strncmp ( sbuff [2 ], "DIMS 5) ==0 ) 

{ 

if  (ndim  ==  2) 

{ 

val  =  sscanf (&buff [7] , "%d  %d\n", &dims [0] , &dims [1] ) ; 

} 

} 

} 

else  if (strncmp (buff, "%", 1) ! =0 ) 

{ 

break; 

} 

} 

val  =  sscanf (&buff [0] , "%lf\n", &dtmp) ; 

arr2d[row] [col]=dtmp; 

col++; 

/*  check  col  bound  here  */ 

if  ((ndim  !=  dim[0])  I  I  (dims[0]  !=  dim[l])  ||  (dims[l]  !=  dim[2 

{ 

exit  (0)  ; 
return  -1; 


/* - PROCESS  DATA - */ 

while  (fgets (buff , 1024, fin)  !=  NULL) 

( 

if  ( strncmp (buff 1 ) ==0 )  continue; 

val  =  sscanf ( &buff [0 ], "%lf\n" , &arr2d [row] [col] ) ; 

col++; 


if  (col  >=  dim[2]) 


{ 

row++; 
col  =  0; 

/*  check  row  bound  here  */ 

} 

if  (row  >=  dim[l])  break; 

} 

fclose (fin)  ; 
return  0 ; 

} 


33 


/*  printtbl.c 

Prints  a  table. 

02-03-27  Update  syntax. 
02-03-18  Created. 


*/ 

#include  <stdio.h> 

int  printtblld (int  *dim,  double  arrld[]) 

{ 

/* - VARIABLES - */ 

int  ndim;  /*  number  of  dimensions  */ 
int  diml;  /*  size  of  diml  */ 

int  dim2;  /*  size  of  dim2  -  not  used  in  Id  */ 
int  i;  /*  loop  counter  */ 
double  tmp;  /*  output  value  */ 

ndim  =  * (dim) ; 

diml  =  * (dim+1)  ; 

for  (i  =  0;  i  <  diml;  i++) 

{ 

tmp  =  arrld[i]; 
printf ( "%lf \n" , tmp)  ; 

} 

return  0; 
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/*  printtbl2d.c 

Prints  a  2d  table. 

02-03-27  Update  syntax. 
02-03-18  Created. 


#include  <stdio.h> 

int  printtbl2d ( int  *dim,  double  arr2d[] [dim[2]]) 

{ 

/* - VARIABLES - */ 

int  ndim;  /*  number  of  dimensions  */ 
int  diml;  /*  size  of  diml  */ 
int  dim2;  /*  size  of  dim2  */ 
int  i,j;  /*  loop  counters  */ 
double  tmp;  /*  output  value  */ 

ndim  =  * (dim) ; 

if  ((ndim  <  1)  I  I  (ndim  >  2))  return  -1; 

diml  =  * (dim+1) ; 

if  (ndim  ==  2)  dim2  =  *(dim+2); 

for  (i  =  0;  i  <  diml;  i++) 

{ 

for  (j  =  0;  j  <  dim2;  j++) 

{ 

tmp  =  arr2d[i][j]; 
printf("%lf  ",tmp); 

} 

printf ( "\n" ) ; 

} 

return  0; 
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APPENDIX  E  -  Result  Comparison 


load  easel  simout  or  load  case2  simout 

Setup  Script 

%28-MAR-02 

addpath  /r/tac3/rtswwb/matlab/func 

load  ./my5/my5  simout 

x=read ( ' outl . txt ',15,0)  ; 

t=x ( : , 1 ) ; 

rpm2=x ( :  ,  2 )  ; 

rpm21=simout . signals . values ( : , 3) ; 
vs=x  ( : , 3)  ; 

vsl=simout . signals . values ( : , 7 ) ; 
th=x ( : , 4 ) ; 

thl=simout . signals . values  ( : , 1 ) ; 
bk=x  ( : ,  5)  ; 

bkl=simout . signals . values  ( : , 2 ) ; 
et=x ( : , 6 ) ; 

etl=simout . signals .values ( : , 10 )  ; 
sr=x  ( : , 8 ) ; 

srl=simout . signals . values ( : , 11 ) ; 
k=x ( : , 9 ) ; 

kl=simout . signals .values  ( : , 12 ) ; 
tqr=x ( : , 10 ) ; 

tqrl=simout . signals . values ( :  ,  13)  ; 
ti=x ( : , 11) ; 

til=simout . signals . values ( : ,  4 )  ; 
tl=x ( : , 12) ; 
g=x ( : , 1 3 ) ; 

gl=simout . signals .values ( :  ,  5)  ; 
up=x  (  : , 1 4 )  ; 

upl=simout . signals .values ( : , 8 ) ; 
dn=x ( : , 1 5 ) ; 

dnl=simout . signals .values ( : , 9) ; 

'  t,  rpm2  ,vs,th,bk,et,sr,k,  tqr ,  ti ,  tl ,  g,  up,  dn  ' 


Output  Figures  Script 

elf 

h=plot (t, rpm2 ,  1  Color ' ,  1 r 1 ,  ' LineStyle 
hold 

plot (t, rpm21 , 1  Color ' ,  ' k '  ,  ' LineStyle ' ,  '  -  ' )  ; 

legend ( ' C ' , ' MATLAB ' ) 

xlabel ( ' TIME  (S) ' ) 

ylabel ( 'ENGINE  SPEED  (RPM) ' ) ; 

%print ( ' -djpeg99 ' , [char (gg (i) )  ' . jpg ' ] ) 

print ( ' -djpeg99 ' ,  1 rpm. jpg 1 ) 

elf 

h=plot (t, rpm2-rpm21 ,  ' Color 1 ,  ' r ' ,  ' LineStyle 1 
legend ('C  -  MATLAB') 
xlabel ( ' TIME  (S) ' ) 

ylabel ( 'ERROR  DIFFERENCE  (RPM) ' ) ; 

%print ( ' -djpeg99 ' , [char (gg (i) )  ' . jpg ' ] ) 

print ( ' -djpeg99 ' , ' rpme . jpg ' ) 


elf 

h=plot ( t, vs , 'Color ' , ' r ' , ' LineStyle 
hold 

plot (t, vsl , 'Color ' , ' k ' , ' LineStyle ' , ' - ' ) ; 

legend  (  ' C ' ,  ' MATLAB ' ) 

xlabel ('TIME  (S) ' ) 

ylabel ( 'VEHICLE  SPEED  (MPH)'); 

print ( ' -djpeg99 ' , ' vs . jpg ' ) 

elf 

h=plot (t, vs-vsl , ' Color ' , ' r ' , ' LineStyle ' , ' - . 
legend ('C  -  MATLAB') 
xlabel ('TIME  ( S )  '  ) 

ylabel ( 'ERROR  DIFFERENCE  (MPH)  ' )  ; 
print ( ' -djpeg99 ' , ' vse . jpg ' ) 


elf 

h=plot (t, th,  ' Color '  ,  ' r ' ,  ' LineStyle 
hold 

plot (t, thl ,  1  Color  '  ,  ' k ' ,  ' LineStyle ' ,  '  -  ' )  ; 

legend ( ' C ' , ' MATLAB ' ) 

xlabel ( ' TIME  (S) ' ) 

ylabel ( 1  THROTTLE  (%)' ); 

print ( ' -djpeg99 ' ,  ' th . jpg 1 ) 


elf 

h=plot ( t, bk,  'Color 1 ,  ' r ' ,  ' LineStyle 
hold 

plot (t, bkl ,  1  Color ' ,  ' k ' ,  ' LineStyle '  ,  '  -  ' )  ; 

legend ( ' C ' , ' MATLAB ' ) 

xlabel ('TIME  (S) ' ) 

ylabel ( 'BRAKE  FORCE  (LBF) ' ) ; 

print ( ' -djpeg99 ' , 'bk. jpg' ) 


elf 

h=plot (t, et, ' Color '  , ' r ' , ' LineStyle 
hold 

plot(t,etl, 'Color', 'k', ' LineStyle '  , ' - ' ) ; 

legend  (  ' C ' ,  ' MATLAB ' ) 

xlabel ('TIME  (S) ' ) 

ylabel ( 'ENGINE  TORQUE  (LBF) ' ) ; 

print ( ' -djpeg99 ' , ' et . jpg' ) 


elf 

h=plot (t, sr , ' Color '  , ' r ' , ' LineStyle 
hold 

plot(t,srl, 'Color', 'k', ' LineStyle ' , ' - ' ) ; 

legend ( ' C ' , ' MATLAB ' ) 

xlabel ( ' TIME  (S) ' ) 

ylabel ( ' SPEED  RATIO ' ) ; 

print ( ' -djpeg99 ' , ' sr . jpg ' ) 


elf 

h=plot (t, k, ' Color ' , ' r ' , ' LineStyle 
hold 

plot (t, kl , 'Color ' , ' k ' , ' LineStyle ' , ' - ' ) ; 
legend  (  ' C ' ,  ' MATLAB ' ) 
xlabel ('TIME  (S) ' ) 

ylabel ( ' K  FACTOR  (RPM/sqrt (FT-LBF) ) ' ) ; 
print ( ' -djpeg99 ' , ' k. jpg ' ) 


elf 

h=plot (t, tqr, ' Color ' , ' r ' , ' LineStyle 
hold 

plot (t, tqrl ,  ' Color ' ,  ' k ' ,  ' LineStyle '  ,  ' -  ' )  ; 

legend ( ' C ' , ' MATLAB ' ) 

xlabel ('TIME  ( S )  '  ) 

ylabel ( ' TORQUE  RATIO ' ) ; 

print ( ' -djpeg99 ' , ' trq. jpg') 


elf 

h=plot ( t, ti , 'Color ' , ' r ' , ' LineStyle 
hold 

plot  (t, til,  'Color',  'k',  ' LineStyle ' ,  ' - ' ) ; 
legend  (  ' C ' ,  ' MATLAB ' ) 
xlabel ('TIME  (S) ' ) 

ylabel ( ' IMPELLER  TORQUE  (LBF) ' ) ; 
print ( ' -djpeg99 ' , ' ti . jpg ' ) 


elf 

h=plot (t, g, ' Color ' , ' r ' , ' LineStyle 
hold 

plot (t, gl , 'Color ' , ' k ' , ' LineStyle ' , ' - ' ) ; 
legend  (  ' C ' ,  ' MATLAB ' ) 
xlabel ('TIME  (S) ' ) 
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ylabel ( ' GEAR ' ) ; 

print (' -djpeg99 ' , 'g.jpg') 


elf 

h=plot (t , up, ' Color '  , '  r '  , ' Line Style 
hold 

plot  (t, upl , ' Color '  ,  ' k ' ,  ' Line Style '  ,  ' - ' ) ; 
legend ( ' C ' , ' MATLAB ' ) 
xlabel ( 'TIME  (S)  ' ) 

ylabel ('UP  SHIFT  THRESHOLD  (MPH)'); 
print (' -djpeg99 ' , 'up. jpg') 


elf 

h=plot (t, dn, ' Color ' , ' r ' , ' LineStyle 
hold 

plot (t , dnl , ' Color ' ,  ' k ' ,  ' LineStyle ' ,  ' - ' )  ; 
legend ( ' C ' , ' MATLAB ' ) 
xlabel ('TIME  (S)') 

ylabel ('DOWN  SHIFT  THRESHOLD  (MPH)'); 
print (' -djpeg99 ' , 'dn.jpg') 


Read  Function 

%function  [A] =read (file, col, skip)  reads  text  file  of  values 
%  INPUT: 

%  file  -  file  name 

%  col  -  number  of  data  columns  in  file 
%  skip  -  number  of  header  lines  to  skip 

%  OUTPUT: 

%  A  -  array  of  values 
function  [A] =READ ( f ile, col, skip) ; 
fid=fopen (file,  ' rt ' ) ; 
for  i=l:skip, 
fgetl (fid) ; 
end 

A=f scanf (fid, ' %lg ' , [col, inf ] ) ' ; 
fclose (fid) ; 
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